#include "motor.h"
#include "pwm.h"

motorDirPin[] = {motorDirPin1, motorDirPin2};

void motorInit(void)
{
    pwmInit();
    motorPin &= ~motorDirPin[0]; // 置0
    motorPin &= ~motorDirPin[1]; // 置0
}

void motorSet(uint8_t ch, int16_t speed)
{
    if (speed < 0)
    {
        pwmSet(ch, 1000 + speed);
        motorPin |= motorDirPin[ch]; // 置1
    }
    else
    {
        pwmSet(ch, speed);
        motorPin &= ~motorDirPin[ch]; // 置0
    }
}

